#include "main.h"
#include "cmsis_os.h"
#include "ble_remote.h"
#include "robot_arm.h"
#include "tim.h"

int32_t angle[3] = {70, 80, 0}; // 调试用
extern remote_t remote;
extern joint_angle joint;

void StartMechArmTask(void const *argument)
{
    RobotArm_Init();
    while (1)
    {
        
        // 调试用
        //Update_Servo_PWM();

        RobotArm_Drive(); // 正式运行时启用
        osDelay(10);
    }
}
